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(54) Verfahren zur Bestimmung von Motorgeschwindigkeit und -beschleunigung, Verfahren zur Erzeugung von 
Beschleunigung/Abbremsung, Beschleunigungs/Abbremsungsteuerverfahen, 
Beschleunigungs/Abbremsungssteuervorrichtung und Motorsteuervorrichturig 

© Eine Beschleunigungs-Verzogerungssteuerung wird 
auf der Grundlage einer angewiesenen Beschleunigungs- . 
differentialsteuerung so durchgefuhrt, dafc ein Maximal- 
betrag Jmax des Beschleunigungsdifferentialwertes, der 
eine Ableitung der Beschleunigung ist, nicht grower als 
ein vorgegebener Wert gemacht wird, wenn ein Soll-Aus- ' 
mafc der Servo motorbewegung kleiner als ein mimimales 
AusmafS Smax der Motorbewegung ist, das erforderlich 
ist, damit die Bewegung des Servomotors eine vorgege- 
bene Maximalgeschwindigkeit Vmax und eine vorgege- 
bene Maximalbeschleunigung Amax erreichen kann. 
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■ : ; Beschreibung . 
Technischer Hintergrund 

100011 Die vorliegende Erfindung betrifft die Steuerung der BeschleunigungAferzogerung eines Motors und insbeson- 
^ e^Sobotennanipulators untlrdriicken zu konnen, wenn ein Befehl zum Bewegen uber emen kurzen Abstand 

t^^X^ZT^^M^or eine Arbeit durch Wiederholen einer Operation des Bewegens 
eineTLdeSoTvon einem gelemten Punkt zum nachsten gelemten Punkt, wie durch eineri Benutzer angewiesen. Iin 
Seb Wvon elnTm gelemten Punkt zu einem anderen eine Beschleunigungs-Aferzogerungssteuerung uber einen 
SrJomoS durchgefflhrt der ein Gelenk des Manipulators betatigt. So wird der Endeffektor auf der Grundlage , einer 
%£gZi Beschleunigungs-ZVerzogerungskurve beschleunigt, bis me Beschleunigung ^^^dStof ^ £ 
geschwindigkeit erreicht. Nach einer vorgegebenen Periode konstanter Geschwmdigkeit wird der Endeffektor _ auf der 
Elage der vorgegebenen Beschleunigungs-ZVerzogerungskurve in der gleichen Werse ,wie be, der Beschle^igung 
So wird die Operation des Anhaltens des Endeffektors am nachsten gelemten Punkt durchgefuhrt. Bei emer 
solchen^^^^ kann eine trapezformige Beschleumgungs-/Verzoge- . 

SS rwrtn. fill einer solchen Beschleunigungs-ZVerzogerungskurve wird jedocb d.e Beschleunigung 
Z ^inerGeschwindigkeitsschaltpunkt, wenn die Beschleunigung beginnt, endet, etc. unstetig Der auf den Manipulator 
ausgetotolIT tessen Schwingung wird an diesem Zeitpunkt stark. Urn StoB und Schwmgung zu vermeiden^ist 
SBesclLnigungs-^erzogemngssteueru worden, bei der sich eine solche Beschleunigungs-/yerzo- 

"ZnS^TSn gesamtln Bereich vom Start P unkt uber die Maximalgeschwindigkeit zum Endpunkt sanft andert, 
urn so eine Stetigkeit der Beschleunigung zu gewahrleisten. : . . ^u winmm a H«Mani- 

[0003] Eine solche Beschleunigungs-ZVerzogem^^^ . 
pulators verstarkt wird, wenn ein Soll-AusmaB der Motorbewegung klemer als em mimmaies AusmaB de Bewepmg ist, 
das erforderhch ist damit die Bewegurig des Motors eine vorgegebene Betriebsgeschwindigkei und Betnebsbeschleu- 
SunTerMcnt (Tm folgenden als eine "kleine Bewegung" bezeichnet). Urn das Problem von Schwmgungen bei emer 
Sen Semen Swegung zu iosen, ist in der japanischen Patentanmeldung Nr. 2-22559 em Verfahren vorgeschlagen 
worden be dem vorab eine Simulation durchgefuhrt wird, urn eine Korrekturdatentabelle zu erzeugen; optimal? Maxi- 
Sto^X^eschleuniguigszeit und Verzogerungszeit auf der Grundlage der Korrekturtabelle besUmmt wer- 
de^f und fS GeschwindigkeitsLrve auf der Grundlage dieser Werte korrigiert wird, urn so Schwmgungen zu unter- 

?0004] n 'Daten in der Korrekturtabelle werden jedoch als ein Simulauonsergebnis erhalten und werden nicht auf der 
Grandlage eines vorgegebenen Algorithms bestimmt. Deswegen muB eine solche Korrekturtabelle durch wiederholten 
35 Versuch und Irrtum erzeugt werden. 

Kurzbeschreibung der Erfindung 

[0005] Die vorliegende Erfindung ist auf dies* Umstande zugeschnitten, und ein Ziel von ihr ist anzugeben: ein Ver- 
fahren zum Bestimmen einer Maximalgeschwindigkeit und einer Maximalbeschleumgung urn erne Beschleunigungs- 
VerSgerungskurve zu erzeugen, mit der eine ein einem mechanischen System erzeugte Schwmgung unterdruck Wer- 
den kann w!nn ein AusmaB von Bewegung, das der kleinen Bewegung entspricht, unter stetig gehaltener Beschleum- 
gung rt'sTschle^ungs-^ gesteuert wird; ein Beschleunigungs-^erzogerungserzeugungsver- 
fahrL^um Er^ugen einer Beschleunigungs-Verzogerungskurve auf der Grundlage der M^ima Igeschwmdigkei und 
MaiimXscnleunigung, die durch das oben erwahnte Verfahren zum Bestimmen von Maximalgeschwrndigke, und 
Maxima beschleunigung gegeben sind; ein Beschleunigungs-ZVerzogerungssteuerverfahren, be, dem das oben erwahnte 
VetfXen zum Bestimmen von Maximalgeschwindigkeit und Maximalbeschleumgung verwendet wird; erne Beschleu- 
Sungs-A'erzogerungssteuervorrichtung, die das. oben erwahnte Beschleunxgungs-ZVerzogerungssteuerverfaluen ver- 
wendet; eine Motorsfeuerungsvorrichtung, die das oben erwahnte Beschleun,gungs-/Verzogerungssteuerverfahren ver- 

r0006 e ] t; Tl) Gemln eiiiem Aspekt der vorUegenden Erfindung ist em Motorgeschwinmgkeit^/Besch^ 
mungsverfahren wie fo lgt konfiguriert. Bei der Beschleunigungs-^erzogerungssteuerung zum stetigen Andem der Be- 
rchSrgung, urn eine Beschleunigung oder Verzogerung durchzufuhren, wird ein Verfahren zum Besurnmen von Ge- 
schwmdigkei und Beschleunigung eines Motors zum Erzeugen einer Beschleumgungs-Aferzogerungskurvefur den Mo- 
or ^dS^^^^ wo'ein'soll-AusmaB der Motorbewegung kleiner als em nuni males AusmaB der Motorbewe- 
gung ist, welches erforderlich ist, damit die Bewegung des Motors eine vorgegebene Maximalgeschwmdigkeit und erne 
vorglXe Maximalbeschleunigung erreichen kann, wobei das Verfahren einen Schntt des Be—ens e,ner Maxr- 
malgelchwindigkeit und einer Maximalbeschleunigung zum Durchfuhren emer angewiesenen StoB- bzw B^hleuni 
SSifferentifdsteuerung gemaB dem SoU-AusmaB der Motorbewegung durchzufuhren, urn emen Max.malbetrag des 
BesS^igungsdifferentialwertes, das ist der Wert der Ableitung der Beschleumgung, nicht groBer als emen vorgege- 

schwindigkeitffieschleunigung wie folgt konfiguriert: Bei der Beschleunigungs-Aferzbgerangssteuerung zum stetigen 
AS Teiner Beschleunigung 8 urn eineBeschleunigung oder Verzogerung dutchzufuhren, wird ein Verfahren zum Be- 
fu™ von Geschwincligkeit und Beschleunigung eines Motors zum.Erzeugen emer Be^chleunigungs-Verzogemngs- 
kurJedes Motors fur den FaU angegeben, daB ein SoU-AusmaB der Motorbewegung klemer als em rfununales AusmaB 
Sotorbeweiung ist, welches frforderlicb. ist, damit die Bewegung des Motors erne vorgegebene Maximalgesch^ 
dfgkeit und eine vorgegebene Maximalbeschleunigung erreichen kann, wobe, das Verfahren emen Schntt des Bestim- 
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mens einer Maximalgeschwindigkeit und einer Maximalbeschleunigung durch Auswahlen und Durchfuhren eines von 
zwei Prozessen entsprechend dem Soll-AusmaB der Motorbewegung umfaBt,' wobei die zwei Prozesse bestehen aus Pro- 
zessen des Bestimmens einer Maximalgeschwindigkeit zum Durchfuhren einer angewiesenen Beschleunigungssteue- 
rung entsprechend dem Soll-AusmaB der Motorbewegung unter Anwendung der angewiesenen Maximalbeschleunigung 
als Maximalbeschleunigung fur die Steuerung und des Bestimmens einer Maximalgeschwindigkeit und einer Maximal- 5 
beschleunigung zum Diirchfuhren einer angewiesenen Beschleunigungsdiflferentialsteuerung entsprechend dem Soll- 
AusmaB der Motorbewegung. derart, dass ein Maximalbetrag des BeschleunigungsdifFerentialwertes, der eine Ableitung 
der Beschleunigung ist, nicht groBer als ein vorgegebener Wert oder gleich dem vorgegebenen Wert gemacht wird. 
[0008] (3) GemaB einem weiteren Aspekt der vorliegenden Erfindung ist ein Verfahren zum Bestimmen einer Motor- 
geschwirtdigkeit/Beschleunigung so beschaffen, daB in dem obigen Absatz (2) der vorgegebene Wert bei der angewiese- to 
nen Beschleunigungsdifferentialsteuerung der maximale Betrag des Beschleunigungsdifferentialwertes bei der angewie- 
senen Beschleunigungsdifferentialsteuerung an einem Schaltpunkt ist, wo der ProzeB geschaltet wird. 
[0009] (4) GemaB einem weiteren Aspekt der vorliegenden Erfindung ist ein Verfahren zum Bestimmen einer Motor- 
geschwindigkeit/Beschleunigung so beschaffen, daB in dem obigen Absatz (3) der maximale Betrag des Beschleuni- 
gungsdifferentialwertes am Schaltpunkt auf der Grundlage einer Maximalgeschwindigkeit festgelegt ist, die erforderlich .. 15 
ist, urn durch die vorgegebene. Maximalbeschleunigung und auf der Grundlage der vorgegebenen Maximalbeschleuni- 
gung das Soll-AusmaB der Motorbewegung zu erreichen. 

[0010] (5) GemaB einem anderen Aspekt der vorliegenden Erfindung ist ein Verfahren zum Bestimmen der Motorge- 
schwindigkeit/Beschleunigung so beschaffen, daB in einem beliebigen dier obigen Absatze (3) und (4) die Einstellung des 
Schaltpunktes nach dem Willen eines Benutzers verandert werderi kann. 20 
[0011] (6) GemaB einem weiteren Aspekt der vorliegenden Erfindung ist ein Verfahren zum Bestimmen der Motorge- 
schwindigkeit/Beschleunigung so beschaffen, daB in einem beliebigen der obigen Absatze (3) bis (5) der Schaltpunkt 
durch einen dimensionslosen Parameter bezeichnet ist. ' 
[0012] (7) Nach einem weiteren Aspekt der vorliegenden Erfindung ist ein Verfahren zum Bestimmen der Motorge- 
schwindigkeit/Beschleunigung so beschaffen, daB in dem obigen Absatz (6) der Parameter als ein Verhaltnis in Bezug 25 
auf das minimale AusmaB der Motorbewegung festgelegt wird. 

[0013] (8) GemaB einem weiteren Aspekt der vorliegenden Erfindung ist ein Verfahren zum Bestimmen der Motorge- 
schwindigkeit/Beschleunigung so beschaffen, daB in einem beliebigen der obigen Absatze (1) bis (.7) die angewiesene 
Beschleunigungsdifferentialsteuerung vorgesehen ist, urn eine Positionierung eines Gegenstandes der Steuerung unter 
Unterdriickung von Schwingungen des Gegenstandes durchzufuhren. 3q 
[0014] (9) GemaB einem Aspekt der vorliegenden Erfindung ist ein Verfahren zum Erzeugen einer Beschleunigungs- 
./Verzogerungskurve so beschaffen, daB die Beschleunigungs-/Verz6gerungskurve auf der Grundlage der Maximalge- 
schwindigkeit und der Maximalbeschleunigung erzeugt wird, die mi t dem Verfahren zum Bestimmen der Motorge- 
schwincHgkeit und Beschleunigung erhalten sind, die in einem der obigen Absatze (1) bis (8) definiert sind. 
[0015] (10) GemaB einem weiteren Aspekt der vorliegenden Erfindung ist ein Verfahren zum Steuern der Beschleuni- 35 
gung/Verzogerung wie folgt konfiguriert. Es ist ein Verfahren zum Durchfuhren einer Beschleunigungs- Verzogerungs- 
steuerung eines Motors vOrgesehen, urn den Motor durch stetiges Andern der Beschleunigung des lylotors zu beschleu- 
nigen/verzogern, wobei das Verfahren einen Schritt. des Durchfuhrens einer Beschleunigungs-A^erzogerungssteuerung 
auf der Grundlage einer angewiesenen Beschieunigungsdifferentialsteuerung derart umfaBt, daB ein Maximalbetrag des 
Beschleunigungsdifferentialwertes, der ein Ableitungswert der Beschleunigung ist, nicht groBer als oder standig gleich 40 
einem vorgegebenen Wert in dem Fall gemacht wird, wo ein Soll-AusmaB der Motorbewegung kleiner als ein minimales 
AusmaB der Motorbewegung ist, das erforderlich ist, damit die Bewegung des Motors eine vorgegebene Maximalge- 
schwindigkeit und Maximalbeschleunigung erreichen kann. 

[0016] (11) GemaB einem weiteren Aspekt der vorliegenden Erfindung ist ein Beschleunigungs-/Verzpgerungssteuer- 
verfahren wie folgt konfiguriert. Es ist ein Verfahren zum Durchfuhren einer Beschleunigungs- Verzogerungs steuerung 45 
eines Motors vorgesehen, bei dem der Motor durch stetiges Andem der Beschleunigung des Motors beschleunigt/abge- 
bremst wird, wobei das Verfahren einen Schritt des Auswahlens und Durchfuhrens eines von zwei Steuerprozessen ent- 
sprechend einem Soll-AusmaB einer Motorbewegung in dem Fall umfaBt, wo das Soll-AusmaB der Motorbewegung 
kleiner als ein minimales AusmaB der Motorbewegung ist, das erforderlich ist, damit die Bewegung des Motors eine vor- 
gegebene Maximalgeschwindigkeit und eine vorgegebene Maximalbeschleunigung erreichen kann, wobei die zwei 50 
Steuerprozesse aus einer angewiesenen Beschleunigungssteuerung und einer angewiesenen Beschleunigungsdifferenti- 
alsteuerung bestehen, wobei die angewiesene Beschleunigungssteuerung den Motor so steuert, daB eine Maximalbe- 
schleunigung in der Beschleunigungs-/Verz6gerungsoperation gleich der vorgegebenen Maximalbeschleunigung wird, 
die angewiesene Beschleunigungsdifferentialsteuerung den Motor so steuert, daB ein Maximalbetrag des Beschleuni- 
gungsdifferentialwertes, der ein Ableitungswert der Beschleunigung ist, nicht groBer als ein vorgegebener Wert oder 55 
konstant gleich diesem wird. 

[0017] (12) GemaB noch einem weiteren Aspekt der vorliegenden Erfindung ist ein Beschleunigungs-/VerzogerungSr 
steuerverfahren so konfiguriert, daB in dem obigen Absatz (11) der vorgegebene Wert in der angewiesenen Beschleuni- 
. gungsdifferentialsteuerung der Maximalbetrag des Beschleunigungsdifferentialwertes in der angewiesenen Beschleunir 
gungssteuerung an einem Umschaltpunkt ist, wo der ProzeB umgeschaltet wird. . 60 

[0018] (13) GemaB einem anderen Aspekt der vorliegenden Erfindung ist ein Beschleunigungs-/Verz6gerungssteuer- 
verfahren so beschaffen, daB in dem obigen Absatz (12) der Maximalbetrag des Beschleunigungsdifferentialwertes am 
Schaltpunkt auf der Grundlage einer Maximalgeschwindigkeit, die erforderlich ist, um das Soll-AusmaB der Motorbe- 
wegung durch die vorgegebene Maximalbeschleunigung zu erreichen, und auf der Grundlage der vorgegebenen Maxi- 
malbeschleunigung spezifiziert ist. - 1 65 
[0019] (14) GemaB einem weiteren Aspekt der vorliegenden Erfindung ist ein Beschleunigungs- /Verzogerungssteuer- 
verfahren so beschaffen, dass in einem beliebigen der obigen Absatze (12) und (13) die Einstellung des Schaltpunktes 
nach dem Wi lien des Benutzers verandert werden kann. 
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r00201 (15) GemaB einem weiteren Aspekt der vorliegenden Erfindung ist ein Beschleunigungs-ZVeraogerungssteuer- 
ISen sfbSSerd^Tn einem beSebigen der obigen Absatze (12) bis (14) der Schaltpunkt durch einen dimensi- - 

SSSf SSSSSS^SSi Aspekt der vorliegendeii Erfindung ist ein »*^^™*S£?Z 
verfahren so beschaffen, daB in dem obigen Absatz (15) der Parameter als Verhaltms rmt Bezug auf das mimmale Aus- 

SS* KSSSL^ der vorliegenden Erfindung ist ein Bescnleunigungs^^ 

verfahren so beschaffen daB in einem beUebigen der obigen Absatze (10) bis (16) die angewiesene Beschleunigungsdif- 

SSteue^g SSsehen ist, nm eine Posiuonierung eines Gegenstandes der Steuerung bei gleichzeitiger Unter- 

unfbeschaffen wie folgt. Eine Beschleunigungs-A'erzogerungssteuervorrichtung zum Durchfuhren einer ^escMeun - 
S*SSSrin^Lung- durch stetiges Andern der Beschleunigung des Motors is voigesehen welche umfaBt 
line f(^S^Ld Beschleunigungsbestimmungseinrichtung zum Bestimmen einer Maxrmalgeschwjndrgkeit 
un e£ ^Emialbeschleunigung zum Durchfuhren einer angewiesenen Beschleunigungsd.fferentialsteuerung so daB 
ein ^in^^Z Lschleumgungsdifferentialwertes, der eine Ableitung der Beschleumgung ist, mcht groBer als 
e n vlreeTeW Wert Oder standig gleich diesem wird, wenn ein Soll-AusmaB der Motorbewegung kleiner als ein mi- 
2 fSS d« Motorbewegtml ist, das erforderlich ist, damit der Motor eine vorgegebene Maximalgeschwindig- 
Maximalbeschleunigung erreichen kann; nnd ^^^1^7^^^ 
gen und Ausgeben lines Positionsreferenzwertes auf der Grundlage der Maximalgeschwmdigk^t und der M» lma lb e - 
schleunigung die durch die Geschwindigkeits- und Beschleunigungsbestimmungseinrichtung erhalten and. 
0024] T WGemaB einem anderen Aspekt der vorliegenden Erfindung ist eine Beschleun W^^SSSSS 
heschaffen wie folgt Es ist eine Beschleunigungs-Aferzogerungssteuervomchtung zum Durchfuhren einer 
Brcnteunf E ungs ^^b^ngle^ng eines Motors "zum Beschleunigen/Verzogem des Motors durch steUges An- 
fder SS^iSfdes Motors vorgUhen, welche umfaBt: Eine Geschwindigkeits- und tochl^iguflgsbesUm- 
JSSSSSSJXb^S™ einer Maximalgeschwindigkeit und einer e ^^^ 

«Z i i,«mhmn eines von zwei Prozessen gemaB einem Soll-AusmaB der einer Motorbewegung, wenn das Soll-AusmaB 
de MotSbeweZg SSSSbSSLb AusmaB der Motorbewegung ist, das erforderlich ist, damit die Bewegung 
d^MotorseTnevofgegebeneMax 

lobS zwe" ProzLfe bestehen aus einem ProzeB zum Neubestimmen einer Maximalgeschwindigkeit zum Durchfuh- 
S angewiesenen Beschleunignngssteuerung auf der Grundlage des SoU-AusmaBes der Mot ^^.^j2 
M^ralbeschTeunigung bei einer Beschleunigungs-Aferzogerungsoperation gleich der vorgegebenen Maximalbe. 
S,^n^ zu mSheS und einem anderen ProzeB zum Neubestimmen einer Maximalgeschwindigkeit und ^eine. -Ma- 
■SSESS^S^^S^ einer angewiesenen Beschleunigungsdifferentialsteuerung auf der Gmndlage 
dSoll-AusmaBes der Motorbewegung derart, dassein Maximalwert des BeschleumgungsdifferenUalwertes der em 
ibldmniwertlrr Stunigun/istfnicht groBer als oder konstant gleich einem vorgegebenen. Wert gemach wird; 
und ehTe ^pSeiSzweherzeugiigseinrichtung zum Erzeugen und Ausgeben eines Positionsreferenzwertes auf der 
G^nTage deSTr Geschwindigkeits- undBeschleunigungsbestimmungseinrichtung erhaltenen Maximalgeschwm- 

U tv£^^™^Aspo kt der vorliegenden Erfindung ist eine Be,chlennigungs-/Verz5 g erungssteuer- 
lornchtun ^ Saffen daB in dem obigen Absatz (19) der vorgegebene Wert bei der angewiesenen B«*bajw^ 
di^rSstenerungderMaxi 

steuerung an einem Umschaltpunkt ist, wo der ProzeB umgeschaltet wird. 

Sol (21) GemaB noch einem weiteren Aspekt der vorliegenden Erfindung ist eine Beschleunigungs-/Verzogerungs- 
SomchmSobeschaffen 

Ss Tdem Umschaltpunkt auf der Grundlage einer Maximalgeschwindigkeit, die erforderlich .st, urn das Soll-AusmaB 
d^MoSeSgung^rit der vorgegebenen Maximalbeschleunigung zu erreichen, und auf der Grundlage der vorgegebe- 

lorrichtung o beschaffen, daB bei einem beliebigen der obigen Absatze (20) und (21) die BescbJeunigm,^Aferzoge- 
run^ssleue^^ femer eine Einstelleinrichtung zum Einstellen und Andem des Schaltpunktes umfaBt. 
Sr SSaB linem weiteren Aspekt der vorliegenden Erfindung ist eine Bi^hleunigung^/Vtozogening«teuer- 
lorncUg so bSaffen daB bei einemUebigen der obigen Absatze (20) bis (22) der Schaltpunkt durch einen dimen- 

SoSuSTbesc haffen, daB in dem obigen Absatz (23) der Parameter ein Verhaltn.s nut Bezug auf das nun,- 

m£of S (25^ 

Stung o be" haffen, daB in einem beliebigen der obigen Absatze (18) und (24) die ^"u^TuSX 
differenaalsteuerung vorgesehen ist, urn die Positionierung ernes Steuerungsgegenstandes unter Unterdruckung der 

t^r^&^t^^^ Erfindung ist ^^~ R %^^t 
Motbrsteuervorrichtung einen Positionsreferenzwert empfangt, der von der ,n einem der obigen Absatze (18) bis (25) de 
nSeS um 50 wenigstens einen Motor gemaB dem 

5 ' IS^^SSSSSm^i (10) (18)und(26)istderMaximalbetragdesBeschleunigungsdifferentialwertesa i Uf 
5eS« Sffil^imibig nicht grbBer als ein vorgegebener Wert wird. Dadurch kann die 
einem durch den Motor angetriebenen mechanischen System aufgepragte Schw.ngung unterdruckt werden. 
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[0033] GemaB Absatzen (2), (9), (11), (19) und (26) wird zwischen der angewiesenen Beschleunigungsdifferential- 
steuerung und der angewiesenen Beschleunigungssteuerung je nach Soll-AusmaB der Motorbewegung umgeschaltet. So 
kann ein System aufgebaut werden, bei dem die Bewegungszeiten verkurzt sind und die Schwingung unterdriickt ist. 
[0034] GemaB Absatzen (3), (4), (9), (12), (13), (20), (21) und (26) ist der vorgegebene Wert bei der angewiesenen Be- 
schleunigungsdifTerentialsteuerung der Maximal-Beschleunigungsdiflferentialwert (das Maximum des Betrages der Be- 5 . 
schleunigungsdifferential) bei der angewiesenen Beschleunigungssteuerung am Umschaltpunkt. Wenn das Soll-AusmaB 
der Motorbewegung stetig verandert wird, andern sich die erhaltene Geschwindigkeit, Beschleunigung und Bewegungs- 
zeit stetig. So wird ein im ganzen naturlicher Betrieb erreicht. 

[0035] GemaB Absatzen (5), (9), (14), (22) und (26) karin der Schaltpunki hach dem Willen eines Beriutzers geandert 
werden. So kann je nach Genauigkeit, zulassigem Schwingungsbereich, etc., die fur den Aufbau des Systems erforder- 10 
lich sind, der optimale Umschaltpunkt eingestellt werden. . 
[0036] GemaB Absatzen (6), (7), (9), (15), (16), (23), (24) und (26) kann der Schaltpunkt durch einen dimehsionslosen 
Parameter bezeichnet werden. Daher kann der Schaltpunkt ohne Riicksicht auf das AusmaB der Motorbewegung einge- . 
stellf werden. . . 

[0037] GemaB Absatzen (8), (9), (17), (25) und (26) kann die angewiesene Beschleunigungsdifferentialsteuerung 15 
durchgefuhrt werden. So kann ein Steuerungsgegenstand positioniert werden, wahrend die Schwingung des Gegenstan- 
des unterdriickt ist. 

Kurze Beschreibung der Zeichnungeh 

20 

[0038] Fig. 1 ist ein Blockdiagramm, das die Konfiguration eirier Beschleunigungs-ZVerzogerungssteueryorrichtung 
gemaB einer Ausgestaltung des ^vorliegenden Erfindung zeigt; 

[0039] Fig. 2 ist ein Graph, der die Beziehung zwischen dem AusmaB der Motorbewegung und dem Beschleunigungs- 
differentialwert mit dimensionslosen Parametern bei einer angewiesenen Beschleunigungssteuerung zeigt; 
[0040] Fig. 3 ist ein Graph, der ein Beispiel einer Beschleunigungs-/Verz6geriingskurve (Sinuskurve) zeigt; 25 
[0041] Fig. 4 ist ein Graph, der ein anderes Beispiel der Beschleunigungs-Aferzogerungskurve (rnodifizierte Sinus- 
. kurve) zeigt; 

[0042] Fig. 5 ist ein Graph, der ein weiteres Beispiel der Beschleunigungs-/Verz6gerungskurve (Dreieckkurve) zeigt; 
[0043] Fig. 6 ist ein FluBdiagramm, das einen FluB der Verarbeitung in einer Ausgestaltung der vorliegenden Erfin- 
dung zeigt; ^ ^ 30 
[0044] Fig. 7 ist ein Graph, der eine Beschleunigungsdifferentialkurve zu der in Fig. 4 abgebildeten Beschleunigungs- 
/Verzogerungskurve zeigt; 

[0045] Fig. 8 ist ein Graph, der eine Beschleunigungsdifferentialkurve zu der in Fig. 5 abgebildeten Beschleunigungs- 
/Verzogerungskurve zeigt; 

[0046] Fig. 9 ist ein Graph, der eine Beschleunigungsdifferentialkurve zu der in Fig. 6 abgebildeten Beschleunigungs- 35 
Verzogerungskurve zeigt; 

[0047] Fig. 10 ist ein Graph zum Erlautem des Unterschieds bei der Restschwingungscharakteristik eines mechani- 
schen Systems mit einem kleinen AusmaB von Motorbewegung zwischen einer angewiesenen Beschleunigungssteue- . 
rung und einer angewiesenen Beschleunigung sdifferentialsteuerung. 

.40 

Detaillierte Beschreibung der bevorzugten Ausgestaltung 

[0048] Vor der Beschreibung einer Ausgestaltung der vorliegenden Erfindung werden die Anforderungen fur die Be- 
schleunigungs-A/erzogerungssteuerung beschrieben. Eine Anforderung ist, daB die einem mechanischen System wie 
oben zum Stand der Technik beschrieben aufgepragte Schwingung unterdriickt wird: Die andere Anforderung ist, die Be- 45 
weguhgszeit (Positionierzeit) zu verklirzen. 

[0049] Ein Verfahren fiir eine angewiesene Beschleunigungssteuerung wird als ein Verfahren zum Befriedigen der 
letzteren Anforderung bei einer kleinen Bewegung angeseheh. Dieses Verfahren ist ein Steuerverfahren, bei dem die Ma- 
ximalgeschwindigkeit verringert wird, wodurch es moglich wird, einen Manipulator mit dem Soli- AusmaB der Bewe- 
gung zu steuem, wahrend eine vorgegebene maximale Beschleunigung als die Maximalbeschleunigung verwendet wird, 50 
Wenn das Verfahren mit einer Beschleunigungs-A^erzogerungskurve eingesetzt wird, die die Stetigkeit der Beschleuni- 
gung erfullt, besteht jedoch eine Neigung, dafi der.Betrieb des Manipulators ins Schwingen gerat. 

[0050] Fig. 2 ist ein erlauternder Graph zur Erlauterung der Schwingung des Manipulators in diesem Fall. Fig. 2 zeigt 
die Beziehung (eine mit (a) bezeichnete Kurve) zwischen dem AusmaB der Motorbewegung und dem Maximum des Be- 
schleunigungsdifTerentialwertes bei der angewiesenen Beschleunigungssteuerung. In dem Graphen sind die horizontale 55 
Achse und die vertikale Achse durch dimensionslose Parameter dargestellt, die durch Dividieren des AusmaBes der Be- 
wegung und des Maximums des Beschleunigungsdifferentialwertes mit jeweiligen Referenzwerten erhalten werden. Da- 
bei wird (b) spater beschrieben. 

[0051] In Fig. 2 ist S das Soll-AusmaB der Motorbewegung, und Smin ist d^s minimale AusmaB der Motorbewegung, 
das erforderlich ist, damit die Motorbewegung eine vorgegebene Maximalgeschwindigkeit und die vorgegebene Maxi- 60 
malbeschleunigung erreichen kann. J ist der Maximal-BeschleunigungsdifFerentialwert bei dem Soll-AusmaB S der Be- 
wegung, und J mkx ist der Maximal-Beschleunigungsdiflferentialwert, wenn die Bewegung keine kleine Bewegung ist 
(d. h. das Soll-AusmaB S der Bewegung nicht kleiner. als S min ist). 

[0052] Der hier verwendete BeschleunigungsditTerentialwert bezeichnet einen Wert, der durch Differenzieren der Be- 
schleunigung erhalten wird. Der BeschleunigungsdifTerentialwert wird als ein Indikator Zum Herausfinden der Tendenz 65 
zum Schwingen genutzt. Es ist die allgemeine Tendenz bekannt, daB eine Schwingung sich verstarkt, wenn der Beschleu- 
nigungsdifferenualwert groB ist. Bezogen auf Fig. 2 und mit Rucksicht auf diese allgemeine Tendenz nimmt der Be- 
schleunigungsdifferentialwert zu, wenn S/Smin gegen Null geht. Das heiBt, es kann angeriommeh werden, daB die 
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Schwineune zunimmt, wenn das Soll-AusmaB der Bewegung abnimmt. 

Fo053V We Z m*2 als Kurve (b) gezeigt, zielt daher die vorliegende Erfindung darauf ab, Restschwmgung zu unter- 
Scken Sm ^£^Liluni^ g ^ K nti^ so begrenzt (gesteuert) wird, daB er in dem Oebiet uber 
dnem ^ X des ^smaBes der Bewegung nicht groBer als ein vorgegebener Wert wird, wobei aber der maximal - B^ 

bei einer Verringerung des Soll-AusmaBes der Bewegung bei der ange swiesenen Beschleu- 
nieuSeuS groBer wird. Das Verfahren zum Bestimmen der Maximalgeschwindigkeit und Maximalbeschleum- 
SfrS Sgen einer Beschleunigungs-/Verz6gerungskurv e zum Durchfuhren einer solchen angewiesenen Be- 

K'slffe^ eJw^fdTe benotigte Bewegufngszeit ist jedoch im Vergleich mit der "^TS?££SSS^ 
rung verlangert. Andererseits hat die angewiesene Beschleumgungssteuerung den Vorteil, daB die Bewegungszei ver 
S werTef kann sie hat aber den Nachteil, daB die Schwingung verstarkt ist. Es gibt zwei Arten von Arbeit bei dem 
EpXoTESpistdie Arbeit, die eine ausreichende Exakmeit verlangt (Arbeit, bei der Restschwmgung ven^ 

weXmms^ 

hdt elnSumf wird Es ist daher bevorzugt, daB das Steuerverfahren entsprechend dem Zweck der AAeit wahlbar ist. 
S Sm Snd fstSese Ausgestaltung der vorliegenden Erfindung so konfiguriert, daB zwischen der angewiesenen 
BeschS^^^ 

SfflSSJSSStatob der Steuerung nach dem Willen des Benutzers festgelegt werden kann. 1 ist ei^ , Block- 
l?gramS das die Konfiguration einer BeschleunigungsWerzogerungssteuervorrichtung nach einer Ausgestaltung der 

,nd Beschleunieunssbestimmungseinrichtung 2 und eine Referenzwerterzeugungsemnchtung 3. Pie Geschwindigkeits 

„ une die einem Soll-AusmaB der Motorbewegung entsprechen, auf der Grundlage des SoU-AusmaBes der Bewegung 

undeiSvo^ " 
und^cU^ 

wert (eine Zielposition oder eine Differenz zwischen der gegenwartigen Position und der Zielposmon) f ortlau ^ auf 
d^S^^Gts^^in^t und Beschleunigung, die von der Geschwindigkeits- und Beschleunigungsbestim- 
muneseinrichtung 2 zugefiihrt werden, und gibt den Positionsreferenzwert aus. ■ L1 nr • »„,,..,«, 

SI" Somotor-ControUer 4 empfangt den Positionsreferenzwert von der Beschleunigungs »"^*? ' 
steuereinrichtung 1 wandelt den Positionsreferenzwert in. einen Drehmomentreferenzwert urn und steuert den Betneb ei- 
nel ^motors 5 auf der Grundlage des Drehmomentreferenzwertes. Die Referenzwerterzeugungseinnchtung S^fuhrt 
eine^Zon^, e£ vojegebenen Zeitraum Tsample wiederholt aus, urn eine Bewegungsbahn von «. _ Bahnan- 
fangspunkt zu "einem Bahnend P unkt zu Widen, und schlieBt die Operation zu einem OperaUonsabsch uBz^itpunkt Tfend 
" ab SL Srvomo"o"controller P 4 fuhrt eine Ruckkopplungssteuerung durch, so daB die Position des Servomotors 5 ,m- 
mereiDer vonderReferenzwerterzeugungseinrichtung3geliefertenPosiUonsreferenzfolgt. , , . 

m0571 Eine itnstelleinrichtung 6 kann von einem Benutzer betatigt werden, um eineh Umschaltpunk zum Umscha - 
£2iJ£3£KU BescWunigungssteuerung und angewiesener ^^SS^SS^SSf^Z 
stellen. Die vom Benutzer zum Einstellen des Schaltpunktes emgegebenen Daten sind e,n Ve ^^ (P^ e ^ r ^> z ^ 
rr.i„i^ a lpn AnsmaB Smin der Motorbewegung, und das Verhaltnis ist bezeichnet durch erne Zahl von 1 bis 100. Auf der 

gZX 1 d^ 

fhlcenden als "Umschaltpunkt Sx" bezeichnet), das gerateseitig als Umschaltpunkt. emgesteUt wird, durch i>x - C x 
sSoO SechnS Der Saftpunkt Sx wird in einem nicht gezeigten Speicher gespeichert wodurch die Einstellung 
ShStSesfx wUendet wird. Dabei kann der Parameter C als direkter Wert durch den Benutzer eingegeben oder 
tus einefSehSahi ^on Werten vom Benutzer ausgewahlt werden. Naturlich kann der Parameter C vorab geratese.Ug als 

^StSMS^L Gm^en, die Beispiele der Beschleunigungskurve zeigen, die die Stetigkeit der Beschleuni- 
lunger^ 

"S?nusku^ eine iurve einer trigonometrischen Funktion (Sinusfunktion), modifiz.ert mit einem Ab- 

scSt ^chfSer Be^hleunigung, der twtehen dem Anfang der Beschleunigung und dem Ende der p B^W 
gun^vSSL isf (im folgenden als "modifizierte Sinuskurve" bezeichnet) und eine ^Kurve einer f« »^ g 
folpenden als "Dreieckkurve" nach ihrer Gestalt bezeichnet). Fig. 3 bis 5 zeigen zwar der Einfachheit halber den hall wo 
S g gleShe^ MSbSeunigungswert Amax sowohl in einem Beschleunigungszeitraum als audi ,n einem Verzoge- 
runSSaumverwendetwird,^ 

deScSi'fe IVr BeU im Beschleunigungszeitraum (d. h. 0< t <T (T : Beschleunigungszeit)) beschneben; 
die Beschreibung des Betriebs im Verzogerungszeitraum wird fortgelassen. •^.^ 
100591 Der Beuieb dieser Ausgestaltung wird im folgenden mit Bezug auf die Zeichnungen beschneben. 
[S] fJ 6 S ein HuBdiagramm, das einen FluB der Verarbeitung in einer Ausgestaltung der vorhegenden Erfin- 

foolirZunachst wird das minimale AusmaB Smin der Motorbewegung berechnet, das erforderlich isU damit die Be- 
wegung des Xtorreine vorgegebene Maximalgeschwindigkeit Vmax und eine vorgegebene Maximalbeschleunigung 
S wk TvomTnolzer vofge 8 geben erreicht (SI). Diese Berechnung wird im folgenden in Verbindung nut jeder Be- 
schleunigungs-/Verzogerungskurve beschneben. 



65 



(1) Hall der Sinuskurve 

[0062] Funktionen fur die Beschleunigung a, Geschwindigkeit v und AusmaB s der Bewegung mit Bezug auf t sind wie 
folgt. 
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a = A^-sin 



(1) 
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V == — - - COS 
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(3) 



wobei(0<t<T) 

[0063] Dabei wird die Beschleunigungszeit T erhalten durch T = 7cVmax/2Amax, weil die Geschwindigkeit v den vor- 
gegebenen Wert Vmax zur Beschleunigungszeit T erreicht. Das minimale AusmaB Smin der Motorbewegung ist ein 
Wert, der erhalten wird durch Verdoppeln eines Integral wertes der Geschwindigkeit v in eihem Zeitraum von der Zeit 0 
bis zur Beschleunigungszeit T (weil das AusrnaB der Bewegung im Verzogerungszeitraum hinzuaddiert wird). Das heifit 
Smin ist gegeben durch den folgenden Ausdruck. * 

Smin = 7cymax 2 /2Amax (4) 

[0064] Im Falle der anderen Beschleunigungs-/Verz6gerungskurven konnen diese Ausdrucke in der gleichen Weise 
wie oben beschrieben erhalten werden. Das.heiBt im Falle der anderen Beschleunigungs-ZVerzogemngskurven werden 
sie erhalten durch Kombinationen der folgenden Ausdrucke (5) bis (8) bzw. (9) bis (12). 
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(2) Fall der modifizierten Sinuskurve 
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s= — ■ t -• — : — : sin 
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(3) Fall der Dreieckkurve 
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Bev^^u'ng kleineral^das ^^i^l^^srS^nain'dMB^^pM^^^^d^^^^ ^" 9 ™ a ® S der Bewegung femer mil 

Der ProzeB »Mn» rtiet M»im»lg«chwmd,gke,i "*?22SEu**iS3SSte M.xim«lge»ch™ndig- 

VerShren »m Besdmmen ein.r M»irn»ig«.chwi»digk,U u„d ei.er M»xin»lb«»ohbu„ig„ng wird n.eh- 
folgend fur jeden der drei Falle beschrieben. 

Fall (I) 

{ 00W De, F1, 0) c-prich, dich, ripe, BWngD ^J^tE^"^ 
/Verzogerungsbetrieb verwendet. 

Fall en) (angewiesene Beschleunigungssteuerung) 

daB der Mo», «»U,„g «m«, Be«hl=u„ igung.tave b <^ d« " A ™Sta J)7(» "nd (12) durch d» SoU- 

wird die Maxirnalge^Windigkeil Va neu bnechne., rndem Smm in den A ^ ck » W V ' ^ ' j, Maiimal- 

genden Ausdriicke 

(1) Fall der Sinuskurve 



Va = (2 • Amax • S/n) m . 
Va = ((7t+2) • Amax • S/rt) 1 ' 2 



(2) Fall der modifizierten Sinuskurve 
(3) Fall der Dreieckkurve 



65 Va = (Amax • S/2) 



1/2 
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Fall (HI) (angewiesene BeschleunigungsdifFerentialsteuerung) 

[0070] In diesem Fall werden sowohl Maximalgeschwindigkeit Va als auch Maximalbeschleunigung Aa neu berech- 
net. Erst wird der Maximalwert Jx des Beschleunigungsdifferentialwertes am Schaltpunkt Sx erhalten (S5). Dann werden 
sowohl Maximalgeschwindigkeit Va als auch Maximalbeschleunigung Aa so neu berechnet, daB der Maximalwert des 
BeschleunigungsdifTerentialwertes Jx wird (S6). Dabei wird der Beziehungsausdruck zwischen Jmax und der vorgege- 
benen Maximalgeschwindigkeit Vmax und der Maximalbeschleunigung Amax vor der Berechnung von Jx erhalten. 
[0071] Fig. 7 bis 9 sind Graphen, die jeweils Beschleunigungsdiflferentialkurven zu den in den Fig. 4 bis 6 abgebilde- 
ten Beschleiinigungs-Aferzogerungskurven zeigen. 

(1) Fall der Sinuskurve 

[0072] Die Beschleunigungsdifferentialfunktion wird erhalten durch Differenzieren der Beschleunigurigsfunktion des 
Ausdrucks (1). Das heiBt, die BeschleunigungsdifFerentialfunktibn ist gegeben durch den folgenden Ausdruck. 



2A 2 



J = 



cos 



2K» 



( o £ t It ) 



[0073] So wird der durch den folgenden Ausdruck gegebene Beziehungsausdruck erhalten. 
Jmax = 2Amax 2 /Vmax 
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[0074] Auch in jedem der Falle (2) und (3) der Beschleunigungs-AVerzogerungskurven wird der Beziehungsausdruck 25 
in der gleichen Weise wie oben beschrieben erhalten. Das heiBt, der Beziehungsausdruck ist wie folgt. 

(2) Fall der modifizierten Sinuskurve 
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\ (3) Fall der Dreieckkurve 

J = Amax 2 ^/max(0<t<T/2) 65 
J = -AmaxWmax(T/2<t<T) 
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J raax = Amax 2 /V max <- 

ximalgeschwindigkeit Vx am ScnaltpuriKt ^ una ^ vvig g e MaximaleeschwincUgkdt Vx enteprcchend 

und dabei Amax unverandert gehalten wird. 

(l)FaU der Sinuskurve 



10 



Jx = 2Amax 2 /Vx; 

(2) Fall der modifizierten Sinuskurve 

15 Jx = (7C+2) • Amax 2 /Vx 

(3) Fall der Dreieckkurve 
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jx = Amax 2 /Vx 

Nachdem ^^^S^^^^^^^^^^^ 
schwindigkeit Va und die Maximalbesch eumgung uien folgenden drei Aus- 

S£S»»igung i. j.weila mi. den folgenden Ausdnicken (13) und (14) bereehne.. 

(1) Fall der Sinuskurve 

Sx = % • Vx 2 /2Amax 

S Va 2 /2Aa . * 

2 • Amax/Vx = 2 • Aa/Va 

(2) FaU der modifizierten Sinuskurve 

Sx ■'= 27t • Vx 2 /(tc+2) • Amax) 
S = n • Va 2 /(7t+2) • Aa) 
((Tt+2) • Amax 2 )/Vx = ((ic+2) • Aa 2 )/Va 

, (3) Fall der Dreieckkurve 

45 Sx = 2Vx 2 /Amax 
S = 2Va 2 /Aa . 
Amax 2 /Vx = Aa 2 /Va 

Va = Vx • (S/Sx) 2/3 (13) - ; • 

Aa = Amax • (S/Sx) l/3 (14) " 
AU( die« Wei, warden « IM---****^^ 

T^J Anscbli.nen^^^ 

die OperanonsnbacblnB*,,, ^!"£2^^,£5S^^ <~i*«, die Zielabacbniua- 
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die OperationsabschluBzeit Tend wxrd berechnet berechnet, die Zielabschnitts- 

wird auf Grundlage der Maximalgeschwmdigkeit Va und der -^^^^^^^^.^^^a^ wird 
referenz wird auf der Grundlage des AusmaBes der Bewegung 4a Der Servomotor-Con- 

dem Servomotor-Controller 4 zugefuhrt (SI 3 und S^)' wahrend erne ^^^1 togesteUt . ^ 
-troller 4 wandelt den Positionsreferenzwert ,n elnen » r ^" S9 bis Schritt S14 wird bis 

erreicht isl (S10) ist 
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die Operation abgeschlossen. Bei dieser Ausgestaltung wurde zwar der Fall gezeigt, wo der AbschluB der Operation an- 
hand der Zeit beurteilt wird, aber selbstverstandlich kann der AbschluB der Operation auch anhand des AusmaBes der 
Bewegung an sich beurteilt werden. Das Verfahren der Kopplung an den Servomotor.Controller 4 ist nicht auf das oben . 
erwahnte Verfahren beschrankt. . . 

[0079] Fig. 10 ist ein Graph zum Erlautern des Unterschieds in der Restschwingungscharakteristik eines mechanischen 5 
Systems bei einer kleinen Bewegung zwischen dem Fall (a), wo das mechanische System unter der angewiesenen Be- 
schleunigungssteuerung steht, und dem Fall (b), wo das mechanische System unter der angewiesenen Beschleunigungs- 
differentialsteuerung steht. Zeit und Amplitude sind jeweils entlang der horizontalen bzw. vertikalen Achse dargestellt, 
der Graph ist allerdings nicht streng quantitativ. Aus Fig. 10 wird deutlich, daB die Restschwingung bei der angewiese- 
nen Beschieunigungsdifferentialsteuerung kleiner ist als bei der angewiesenen Beschleunigungssteuerung. io 
[0080] Wie pben im iDetail beschrieben, wird bei dieser Ausgestaltung der maximale Beschleunigungsdifferentialwert 
bei der angewiesenen Beschleuhigungsdifferentialsteuerung mit einem vorgegebenen Wert in Ubereinstimmung ge- 
bracht, so daB der maximale Beschleunigungsdifferentialwert begrenzt ist und daran gehindert ist, eineri groBen Wert an- 
. zunehmen. Dadurch kann die einem Manipulator aufgepragte Schwingung unterdruckt werden. 

[0081] Insbesondere beim Antreiben (Beginn der Beschleunigung) oder Anhalten (Ende der Verzogerung) des Mani- 15 
pulators, wenn der Beschleunigungsdififerentialwert maximal wird, kann ein Arm. des Manipulators ohne starke Schwin- 
gung angetrieben oder ahgehalten werden. Dadurch wird die Restschwingung verringert, so daB eine schnelle Positionie- 
rung durchgefuhrt und die Arbeitsgeschwindigkeit verbessert werden kann. 

[0082] Ferner wird bei der angewiesenen Beschleunigungsdifferentialsteueruhg der maximale Beschleunigungsdiffe- 
rentialwert am Schaltpunkt bei der angewiesenen Beschleunigungssteuerung als maximaler Beschleunigungsdifferenti- 20 
alwert der angewiesenen Beschleunigungsdifferentialsteuerung verwendet, so daB die Geschwindigkeit, die Beschleuni- 
gung und die Bewegungszeit sich entsprechend dem AusmaB der.Bewegung des Manipulators stetig andern. Dadurch 
wird ein im Ganzen naturlicher Betrieb erreicht 

[0083] Ferrier kann zwischen der angewiesenen Beschleunigungsdifferentialsteuerung und der angewiesenen Be- 
schleunigungssteuerung umgeschaltet werden. Daher kann ein System sowohl im Hiriblick auf eine Verringerung der Be- 25 
wegungszeit als auch eine Unterdriickung der Schwingung konstruiert werden. 

[0084] Ferner kann der Umschaltpunkt nach dem Willen des Benutzers verandert werden. Der Umschaltpunkt kann 
also so eingestellt werden, daB er entsprechend der Exaktheit, dem zulassigen Schwingung sbereich, etc., die fur das kon- 
struierte System erforderlich sind, optimiert wird. 

[0085] Ferner kann der Schaltpunkt durch einen dimensionslosen Parameter (Rate) bezeichnet werden. Daher kann der 30 
Schaltpunkt ohne Beriicksichtigung des AusmaBes der Motorbewegung eingestellt werden. 

[0086] Diese Ausgestaltung ist zwar in Verbindung mit den drei Fallen der Beschleunigungsfunktion beschrieben wor- 
den, doch ist die vorliegende Erfindung nicht hierauf beschrankt, und eine beliebige Funktion kann ausgewahlt werden, 
wenn die Funktion stetig ist. 

[0087] - Die Ausgestaltung ist zwar fur den Fall beschrieben worden, daB ein SeryomotorS vorgesehen ist, doch versteht 35 
sich, daB auch eine Mehrzahl von Servomotoren vorgesehen sein kann. 

Patentanspruche 

1. Verfahren zum Bestimmen von Geschwindigkeit und Beschleunigung eihes Motors zum Erzeugen einer Be- 40 
schleunigungs-A/erzogerungskurve des Motors bei einer Beschleunigungs-/Verz6gerungssteuerung mit stetiger An- 
derung der Beschleunigung in dem Fall, wo ein Soll-AusmaB der Motorbewegung kleiner als ein minimales Aus- 
maB der Motorbewegung ist, das erforderlich ist, damit die Bewegung des Motors eine vorgegebene Maximalge- 
schwindigkeit und eine vorgegebene Maximalbeschleunigung erreichen kann, wobei das Verfahren einen Schritt 

des Bestimmens einer Maximalgeschwindigkeit und einer Maximalbeschleunigung zum Durchfuhren einer ange- 45 
wiesenen Beschleunigungsdifferentialsteuerung entsprechend dem Soll-AusmaB der Motorbewegung umfaBt, so . 
daB ein Maximalbetrag des Beschleunigungsdifferentialwertes, d. h. der Ableitung der Beschleunigung, nicht gro- 
Ber als ein vorgegebener Wert oder gleich dem vorgegebenen Wert wird. .• 

2. Verfahren zum Bestimmen von Geschwindigkeit und Beschleunigung eines Motors zum Erzeugen einer Be- 
schleunigungs-A/erzogerungskurve des Motors bei einer Beschieunigungs-A/erzogerungssteuerung mit stetiger An- 50 
derung der Beschleunigung, in dem Fall, wo ein Soll-AusmaB der Motorbewegung. kleiner als ein minimales Aus- 
maB der Motorbewegung ist, das erforderlich ist, damit die Bewegung des Motors eine vorgegebene Maximalge- 
schwindigkeit und eine vorgegebene Maximalbeschleuhigung erreichen kann, wobei das Verfahren einen Schritt 

des Bestimmens einer Maximalgeschwindigkeit und einer Maximalbeschleuhigung durch Auswahlen und Durch- 
fuhren eines von zwei Prozessen entsprechend dem Soll-AusmaB der Motorbewegung umfaBt, wobei die zwei Pro- 55 
zesse aus Prozessen bestehen: zum Neubestimmen einer Maximalgeschwindigkeit zum Durchfuhren einer ange- 
wiesenen Beschleunigungssteuerung. entsprechend dem Soll-AusmaB der Motorbewegung, wobei die vorgegebene 
Maximalbeschleunigung als eine Maximalbeschleunigung fur diese Steuerung angepaBt wird; und zum Bestimmen 
einer Maximalgeschwindigkeit und einer Maximalbeschleunigung zum Durchfuhren einer angewiesenen Beschleu- 
nigungsdifferentialsteuerung entsprechend dem Soli-Ausmafi der Motorbewegung, um einen Maximalbetrag des 60 
Beschleunigungsdifferentialwertes, der eine Ableitung der Beschleunigung ist, nicht groBer als einen vorgegebenen 
Wert oder gleich dem vorgegebenen Wert zu machen. 

3. Verfahren zum Bestimmen von Geschwindigkeit und Beschleunigung eines Motors nach Anspruch 2, bei dem 
der vorgegebene Wert bei der angewiesenen Beschleunigungsdifferentialsteuerung der Maximalbetrag des Be- < 
schleunigungsdifferentialwertes bei der angewiesenen Beschleunigungssteuerung an einem Umschaltpunkt ist, wo 65 

. der ProzeB umgeschaltet wird. ' 

4. Verfahren zum.Bestimmen von Geschwindigkeit und Beschleunigung eines Motors nach Anspruch 3, bei dem 
der Maximalbetrag des Beschleunigungsdifferentialwertes an dem Umschaltpunkt auf der Grundlage einer Maxi- 
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maleeschwindmkeit spezifiziert wird, die erforderUch ist, um das SoU-AusmaB der Motorbewegung mit der vorge- 
S2 TenMSSlscWeunigung auf der Grundlage dex vorgegebenen Maximalbeschleunigrong zu erreichen 
f Verf^e^im B^stiimnen von Geschwindigkeit und Beschleunigung eines Motors nach emem der Anspruche 3 
L iteTdemTe KnsXng des Umschaltpunktes von einem Benutzer willkurUch verandert wertovkann _ 

6 vtrfanren^um ^BesLmen^on Geschwindigkeit und Beschleunigung eines Motors nach einem der Anspruche 3 
bis 5 bei dem der Umschaltpunkt durch einen dimensionslosen Parameter bezeichnet ist. 

7 vSen zmn BeTtimnin von Geschwindigkeit und Beschleunigung eines Motors nach Anspruch 6, bei dem 
■/W Parameter ein Verhaltnis relativ zum minimalen AusmaB der Motorbewegung ist. • 

8 vS^mBSEei Tvon Geschwinmgkeit und Beschleunigrmg eines Motors nach emem der Anspruche 1 
L^be^Tm^ BeschleUnigungsdifferentialsteuerung vorgesehen ist, nm erne ^merung ernes 
sLe^gsgegenstandes durchzufflhren und dabei eine Schwingung des Gegenstandes ZU f ^ ter ^"- _ u 

9 V^rtXzumErzeugene^ 

^ens einer Beschleunigungs-A'erzogerurigskurve auf der Grundlage der Maximalgeschwmdigkeit und der Maxi- 
'SSS^Sm& mit dem Verfahrln zum Besummen von Geschwindigkeit und Beschleunigung ernes Mo- 
tors wie in einem der Anspruche 1 bis 8 deflniert, erhalten wurden. " xyr'^r 
?0 ^rfXr ^m Durchffihren einer Beschleunigungs-ZVerzogerungssteuerung ernes Motors um den Motor 
Hnrch steSS Andem der Beschleunigung des Motors zu beschleunigen/verzogern, wobei das Verfahren einen 
StSSu^&ns e£e Beschllunigungs-ZVerzogerungssteuerung auf der Grundlage ~ 
BeSleunieunes^fferendalsteuerung umfaBt, um einen Maximalbetrag des Beschleumgungsdiflferenbalwertes, 
to em^leta^^^ ist, nicht groBer als einen vorgegebenen Wert oder konstant gleich dem vor- 
r E ebTneTwert zu machen, wenn ein SoU-Aus 

forbewejunglft, daserforderlich ist, damit die Bewegung des Motors eine vorgegebene Maximalgeschwmdigkeu 
und eine vorgegebene Maximalbeschleunigung erreichen kann. „. m TWhleuni'iren7 

U Verfahren zum Durchfuhren einer Beschleunigungs-ZVerzogerungssteuerung ernes Motors zum Be ^^umgen/ 
VerzSImaes Motors durch stetiges Andern der Beschleunigung des Motors wobe, das Verfahre einenj Schntt des 
Au?wlh™ns^nd Durchfuhrens eines von zwei Steuerprozessen entsprechend emem SoU-AusmaB d« Motorbewe- 
tunTir ( dem Fall umfaBt, wo das SoU-AusmaB der Motorbewegung kleiner als ein mimmales AusmaB der ^Mo tor- 
Sgung ^t d^rforderbch ist, damit die Bewegung des Motors eine vorgegebene Maxrmalgeschmndrgkert und 
d!TvT g eSnrMaximalbeschleunigung erreichen kann, wobei die. zwei Steuerprozesse aus einer angewiesenen 
^^StowssSng und einer angewiesenen Beschleunigungsdifferentialsteuerung bestehen wobe, die an- 
gew e ene ^^lescSgungssteuerung den Motor so steuert, daB eine Maximalbeschleunigung bei der Be^hleum- 
^r^ooerunesoDeration gleich der vorgegebenen Maximalbeschleunigung wird und die angewiesene Be- 
SSSS^SSSSSg den Motor^ steuert, daB ein Maximalbetrag ^^hleunigung^enj^ 
wertirierS Ableitung der Beschleunigung ist, nicht groBer als oder konstant gle 1C h einem vorgegebenen Wert 



35 wird. 



12 Verfahren zum Durchfuhren einer Beschleunigungs-ZVerzogerungssteuerung nach Anspruch 11 bei dem der 
vorgegebte Wen bei der angewiesenen Beschleunigungs^^ 

gungsdifferentialwertes bei der angewiesenen Beschleumgungssteuerung an emem Umschaltpunkt ist, wo der Fro 

if VerfSen'Sm Durchfuhren einer Beschleunigungs-ZVerzogerungssteuerung nach Anspruch 12, wo *Mto 
malb^^Be^ 

^dTe 8 eSrSSum das SoU-AusmaB der Motorbewegung mit der vorgegebenen Maximalbeschleunigung 
zu erreichen, und auf der Grundlage der vorgegebenen Maximalbeschleunigung spez,nz,ert . 

14 Verfahren zum Durchfuhren einer Beschleunigungs-ZVerzogerungssteuerung nach einem d^Anspruche 1 2 und 

13 bei dem die Eiristellung des Schaltpunktes willkurlich durch einen Benutzer geandert werden kann. 

15 VerfXS IzumDurchfuhren einer Beschleunigungs-ZVerzogerungssteuerung nach emem der Anspruche 12 b,s 
14', bei dem der Schaltpunkt durch einen dimensionslosen Parameter bezeichnet wird _ 

16 Verfahren zum Durchfuhren einer Beschleunigungs-/Verz6genmgs S teuerungnach Anspruch 15, bei dem der 
Parameter ein Verhaltnis relativ zu dem minimalen AusmaB der Motorbewegung 1st 

irShren zum Durchfuhren einer Beschleunigungs/Verzogerungssteuerung nach einem der Anspruche 10 b,s 
16 Jet dSe angewiesene Beschleunigungsdifferentialsteuerung vorgesehen. ist, um be, der Positioning ernes 
rvcenstandes der Steuerune eine Schwingung dieses Gegenstandes zu unterdrucken. 

X ^SnSnX/Vfer^getungssteu^voiichtting zum Durchfuhren einer B^hleumg^gs-Afeizogerungs- 
^SSSSSa zumBeschleunigen/Verzogem des Motors durch steiiges Andem der Beschleumgung des 



55 Motors, mit: 



efner GeSwindigkeits- und Beschleunigungsbestimmungseinrichtung zum Besummen einer Maxim Jg^hwm- 
Sek und einer Maximalbeschleunigung zum Durchfuhren einer angew,esenen Beschleunigungsdiflferential- 
Serung so ein Maximalbetrag L Beschleunigungsdifferentialwertes, der eine Ab eitung Beschleum- 
Jun^st nicht gfoBef als oder konstant gleich einem vorgegebenen Wert wird, wenn em SoU-AusmaB der Motorbe- 
■SKSSSSdS mimmales AusmaB der Motorbewegung ist, das erforderUch 1st damit die Bewegung des 
Sors efne vorgegebene Maximalgeschwindigkeit und eine vorgegebene Maximalbeschleunigung erreichen kann, 

ehfer Referenzwerterzeugungseinrichtung zum Erzeugen und Ausgeben eines Positionsreferenzwertes auf der 
SS^^^iin^hwinagkeit udd to Maximalbeschleunigung, die durch d.e Geschwind.gkeits- und 

TSSSS^^^^^^r, DurchfUhren einer Bpchleunigungs-ZVerzogerungs- 
jLerung LlneSors zum Beschleunigen/Verzogem des Motors durch stetiges Andem der Beschleunigung des 
Motors, mit: _ . 
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einer Geschwindigkeits- und Beschleunigungsbestimmungseiniichtung zum Bestinunen einer Maximalgeschwin- 
digkeit und einer Maximalbeschleunigung durch Auswahlen und Durchfuhren eines von zwei Prozessen entspre- 
cjiend. einem Soll-AusmaB der Motorbewegung. in dem Fall, wo das Soll-AusmaB der Motorbewegung kleiner als 
ein minimales AusmaB der Motorbewegung ist, das erforderlich ist, damit die Bewegung des Motors eine vorgege 
bene Maximalgeschwindigkeit und eine vorgegebene Maximalbeschleunigung erreichen kann, wobei die zwei Pro- 
zesse bestehen aus einem ProzeB zum Neubestimmen einer Maximalgeschwindigkeit zum Durchfuhren einer ange- 
wiesenen Beschleunigungssteuerung auf der Grundlage des Soll-AusmaBes der Motorbewegung, urn eine Maxi- 
malbeschleunigung bei der Beschleunigungs-/Verzogerungsoperation gleich der vorgegebenen Maximalbeschleu- 
nigung zu macjhen, und einem anderen ProzeB zum Neubestimmen einer Maximalgeschwindigkeit und einer Maxi- 
malbeschleunigung zum Durchfuhren einer angewieseneri Beschleunigungsdifferentialsteuerung auf der Grundlage 
des Soll-AusmaBes der Motorbewegung derart, dass ein Maximalbetrag des Beschleunigungsdifferentialwertes, der 
eine Ableitung der Beschleunigung ist, nicht groBer als oder konstant gleich einem vorgegebenen Wert gemacht 
wird; und 

einer Referenzwerterzeugungseinrichtung zum Erzeugen urid Ausgeben eines Positionsreferenzwertes auf der 
Grundlage der Maximalgeschwindigkeit und Maximalbeschleunigung, die durch die Geschwindigkeits- und Be- 
schleunigungsbestimmungseinrichtung erhalten sind. 

20. Beschleunigungs-A^erzogerungssteuervprrichtung nach Anspruch 19, bei der der vorgegebene Wert bei der an- 
gewiesenen Beschleunigungsdifferentialsteuerung der Maximalbetrag des Beschleunigungsdifferentialwertes bei 
der angewiesenen Beschleunigungssteuerung an einem Umschaltpunkt ist, wo der ProzeB umgeschaltet wird. 

21 . Beschleunigungs- /Verzogerungssteuervorrichtung nach Anspruch 20, bei der der Maximalbetrag des Beschleu- 
nigungsdifferentialwertes an dem Umschaltpunkt auf der Grundlage einer Maximalgeschwindigkeit, die erforder- 
lich ist, um das Soll 7 AusmaB der Motorbewegung durch die vorgegebene Maximalbeschleunigung zu erreichen- 
und auf der Grundlage der vorgegebenen Maximalbeschleunigung spezifiziert ist. 

22. Beschleunigungs-A^erzogerungssteuervorrichtung nach einem der Anspruche 20 und 21, ferner mit einer Ein- 
stelleinrichtung zum Einstellen und Andern des Umschaltpunktes. 

23. Beschleunigungs- A^erzogerungssteuervorrichtung nach einem der Anspruche 20 bis 22, bei der der Umschalt- 
punkt durch einen dimensionslosen Parameter bezeichnet ist. 

24. Beschleunigungs- /Verzogerungssteuervorrichtung nach Anspruch 23, bei der der Parameter ein Verhaltnis re- 
lativ zu dem minimalen AusmaB der Motorbewegung ist. 

25. Beschleunigungs-A^erzogerungssteuervorrichtung nach einem der Anspruche 18 bis 24, bei der die angewie- 
sene Beschleunigungsdifferentialsteuerung vorgesehen ist, um eine Positionierung eines Gegenstandes der Steue- 
rung durchzufiihren und dabei eine Schwingung dieses Gegenstandes zu unterdriicken. 

26. Motorsteuervorrichtung mit einer Einrichtung zum Empfangen eines Positionsreferenzwertes, der von der in ei- 
nem der Anspruche 18 bis 25 definierten Beschleunigungs-A^erzogerungssteuervorrichtung geliefert wird, urri we- 
nigstens einen Motor gemaB dem Positionsreferenzwert zu steuern. 

Hierzu 5 Seite(n) Zeichnungen 
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